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Abstract 


In this thesis, the problem of developing closed-form dynamic equations and designing 
a PD controller for the 3-DOF planar parallel manipulator is addressed. The overall dy- 
namic model is derived using the Newton-Euler approach. After obtaining the closed- 
form equations of motion of the manipulator, the PD controller is designed. The purpose 
of this controller is to maintain the dynamic response of the manipulator in accordance 
with some prespecified performance criteria. The closed form dynamic equations are 
non-linear in form and are linearized about a point using first order Taylor’s expansion. 
Hence the linear control laws were applied. State variable analysis is used for determining 
the dynamic transient response of the system. Position and velocity gains of the system 
are determined. Simulation results are presented to show the effectiveness of this con- 
trol approach for both the regulation as well as for tracking the trajectory. The controller 
developed is implemented on a physical prototype and the experimental results are also 
reported. 
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Chapter 1 
Introduction 


1.1 Background and Motivation 

Parallel manipulators are robotic devices that differ from the traditional serial robotic 
manipulators by virtue of their kinematic structure. Parallel manipulators are composed 
of multiple closed kinematic loops. Typically, these kinematic loops are formed by two or 
more kinematic chains that connect a moving platform to a base, where one joint in each 
chain is actuated and the other joints are passive. This kinematic structure allows parallel 
manipulators to be driven by actuators positioned at or near the base of the manipulator. 

In contrast, serial manipulators do not have closed kinematic loops and are usually 
actuated at each joint along the serial linkage. Accordingly, the actuators that arts located 
at each joint along the serial linkage experience additional weight of actuators apart from 
the link weight, whereas the links of a parallel manipulator generally need not carry the 
load of the actuators. This allows the parallel manipulator links to be made lighter than 
the links of a comparable serial manipulator. Hence, parallel manipulators can enjoy the 
potential benefits associated with light weight constmction such as high-speed operation 
and improved load to weight ratios. 

• Fig. 1.1 shows the architecture of serial and parallel manipulators. A parallel manipu- 
lator consists of two platforms connected by several legs. The top platform is usually free 
to move and is called the end-effector. The bottom platform is usually fixed and will be 
called the base. The relative positions of the end-effector and base may be reversed for 
some applications. The advantage of serial manipulator is large workspace and dextrous 
maneuverability like human arm, but their load carrying capacity is rather poor due to 
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(a) Serial 

Figure 1.1: Architecture of Serial and Parallel Manipulators 

cantilever structure. Because of cantilever beam-like architecture (as we can see in Fig. 
1.1), serial manipulators inherently suffer from some drawbacks such as low mechani- 
cal stiffness which leads to lower operational accuracy, poor dynamic characteristics and 
lower load carrying capacity. Therefore, whenever precise positioning and orientation is 
required, parallel manipulator is a better choice. 

Until now, significant work has been done in both the dynamic equations formulation 
and the control of serial manipulators but not in parallel manipulators. Recently the ad- 
vantage of parallel manipulators in precise positioning has been understood. In closed 
loop manipulators, significant work has been done on dynamic equations formulation. 
Considerable work is done on designing also, but not much work is reported in control 
of closed-loop manipulators which is a motivation in taking up the work presented in this 
thesis. 



1.2 Manipulator Model and Degrees of Freedom 

A 3rDOF planar parallel manipulator is shown in the Fig. 1.2. It has three legs, each 
leg having two links connected with revolute joints.The end points of the three legs are 
connected to the platform at A,B,C. All the seven movable links are connected with revo- 
lute joints which allow the positioning and the orientation of the platform in a plane. The 
motors are placed at M1,M2,M3. 
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For a serial manipulator the DOF of the system is given by 


DOF = ^ 

t=l 

where /* corresponds to the DOF of the joint of the manipulator containing j joints. In 
general, for serial manipulators, the DOF will be equal to the number of links as each link 
has a single DOF. For parallel manipulators the formula is (Grubler-Kutzbatch-Chebyshev 
formula) 


DOF^n{L-J-\) + ^fi (1) 

2=1 

where L = number of links, J = number of joints, fi = DOF of joint and n = 6 for 
spatial manipulators while n = 3 for planar manipulators. 

There are total L=8 links (7 movable links and one fixed base), j=9 joints. By using 
the Eqn. 1 for finding the degrees of freedom, we get that the degrees of freedom for 
3-DOF planar parallel manipulator is 3. 


1.3 Dynamics 

Euler-Lagrange formulation and Newton-Euler formulation are the two broadly adopted 
approaches for dynamic analysis of robot manipulators. The dynamic equations for 
the 3-DOF planar parallel manipulator are derived by using Newton-Euler approach be- 
cause it is computationally efficient for parallel manipulators as shown in Choudhury and 
Dasgupta[l]. 


1.4 Servo Control 

The inverse problem for manipulator dynamics, namely, the problem of computing the 
joint torques required to produce given end-effector positions, velocities, and acceler- 
ations, has been a computational bottleneck in the control of manipulators. This was 
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mainly because of the need of computations of torques for trajectories in real time. Be- 
cause of the importance of the problem and the computational complexity of the equa- 
tions, the subject has been an attractive area of study in the recent years. This thesis is 
mainly focussed on the position and tracking of the 3-DOF planar parallel manipulator. 
Based on inverse dynamic model of the manipulator, PD control scheme is used for con- 
trolling the manipulator. Since the equations are non-linear in form, they are linearized 
about a point using first order Taylor’s expansion. Hence the linear control laws were 
applied. State variable analysis is used for determining the dynamic transient response of 
the system. The purpose of a positional controller is to servo the motor so that the ac- 
tual angular displacement of the joint will track a desired path specified by a pre-planned 
trajectory. The technique is based on using the error signal between the desired and ac- 
tual angular positions of the joint to actuate an appropriate voltage. In other words, the 
applied voltage to the motor is linearly proportional to the error between the desired and 
actual angular displacement of the joint. Position and velocity gains of the system are 
determined. 


1.5 Objective of this Thesis 

Developing the dynamic equations, designing a proper proportional-derivative controller 
and studying the dynamic response behavior of 3-DOF planar parallel manipulator is the 
aim of the research reported in this thesis. Finally the designed controller is implemented 
on a physical prototype developed by Kalva [2]. 


1.6 Literature Review 

A general strategy based on the Newton-Euler approach to the dynamic formulation of 
parallel manipulators is developed by Choudhury and Dasgupta [1]. Marvin Minsky [3] 
of the MIT was the first person who introduced the term “parallel manipulator” in his 
early AI memo “Manipulator design vignettes”. According to his memo, the parallel con- 
cept is best illustrated by the way an animals body is supported by its legs, where several 
constraints simultaneously determine the relationships of one body to another. The planar 
3-DOF manipulator was introduced by Hunt [4] in 1983. Ma and Angeles [5] studied di- 
rect kinematics and dynamics of the planar 3-DOF parallel manipulator. In their method. 
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one of the links of the manipulator is removed virtually so that only one of the three kine- 
matic loops remains, which reduces the non-linear constraint equations from three to one 
and a technique of 4-bar linkage performance evaluation applied to find the position of 
end effector. In the dynamics formulation, the natural orthogonal complement is applied, 
which leads to the algorithm oriented equations of motions involving independent gener- 
alized coordinates. 

An optimal control approach to robot manipulator pole placement is discussed by Ray- 
mond [6]. In their method. Nonlinear control laws are employed to disqualify the non- 
linear dynamics of a robot manipulator. The remaining dynamics are controlled by a 
linear-quadratic (LQ) optimal conti'ol scheme which results in the servomechanism prob- 
lem. The steady-state feedback gains can then be found in closed form as a function of 
the weighting parameter. A lot of web information on control is collected from the site 
WWW. google, com. 


1.7 Organization of the Thesis 

The organization of the thesis is as follows: 

Chapter 2 discusses the dynamic equation formulation of the 3-DOF planar parallel ma- 
nipulator. 

Chapters deals with the controller design for controlling the manipulator. 

Chapter 4 deals with the Simulation Results and Discussions. 

Chapter 5 discusses about control of DC motors, software and hardware implementation 
required for 3-DOF planar parallel manipulator. 

Chapter 6 discusses the Experimental Results obtained from the physical prototype. 
Chapter 7 discusses the Concluding remarks and Suggestions for further work. 
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Chapter 2 

Dynamic Formulation of the 
Manipulator 


2.1 Procedure 

The Newton-Euler method of dynamic formulation is based on the direct application of 
Newton’s law and Euler’s equation in the form 

]^F=rria (1) 

and 

Vm + ^ r X F = Tcp X ma 4- la + w x Iw (2) 

to individual bodies. This yields three scalar equations (for planar case) for each body. 
In the present work, the dynamic formulation of parallel manipulators is considered in 
task-space because of the simplicity of the resulting equations. The salient features and 
steps of the strategy (see [1]) are described as following: 

• For each leg, 

- Find the position, velocity and acceleration of the platform-connection-point 
from (or in terms of) the task-space coordinates and their derivatives. 
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GLOBAL FRAME OF REFERENCE 
Figure 2.1 : Notations of the Leg 

- Solve the kinematics of the leg for position, velocity and acceleration. 

- Now, first obtain the moment equilibrium equation for the upper link about 
the intermediate joint. Then obtain moment equilibrium equation for both the 
links about the base joint. 

- From the equations obtained above, solve the reaction at the platform-connection- 
point in terms of the actuations in the leg and the platform accelerations X 

• Consider equilibrium of the platform and write Newton’s and Euler’s equations 
for it. Simplify the equations to the standard form (resulting in the closed-form 
dynamic equations). 
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2.2 Notations for the Leg 


The notations for the leg as shown in Fig.2.1 are 
Ci The unit vector along the lower link of i-th leg 

di The unit vector along the upper link of i-th leg 

ji The joint vector of the intermediate revolute joint 

bi Base point of the i-th leg 

ti Platform connection point 

T End-effector point 

S; Vector joining the base to the platform connection point 
a Orientation of the platform 

X Task space position of the end-effector 

R The rotation matrix 

x’-y’ The frame fixed to the platform 

x”-y” The frame on the platform and parallel to the Global Frame of reference 
dx represents the vector d rotated anti-clockwise by a right angle 


2.3 Inverse Kinematics of the Manipulator 

With the previous notation for the leg vector and denoting the lengths of the lower and 
upper links by I and u respectively, the position kinematics of a single leg is determined 
as follows: 


The position, velocity and acceleration of the platform connection points is 



X 


tl = 

V 

+ 


m U 

L. 

t2 = 

X 

- 

y 

+ 


- -i 


*3 = 

X 

■ 

y 

-F 


cos (a) 
sin (a) 

cos (a) 
sin (a) 

cos (a) 
sm(a) 


—sin{a) 

-p/2 

cos{a) 

_-q/i_ 

—sin{n) 

■p/2' 

cos (a) 

-?/3 


—sin {a) 


' 0 

cos{a) 


_2g/3 
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AB=’p’ is the side of each platform 

’q’ is the height of the platform 
’ o’ is the end effector position [x y] 

Figure 2.2: The positions of platform connection points with respect to platform frame 
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X y 

X y 


-sinipc) —cos{a) 
cos{a) —fiin{a) 


—cos{cx) f>in{a) I — 


A 

, O' 

-q/3 


-sinia) —cofiipi) — 


-pi 2 ^ 2 _|_ -sin (a) -cos (a) 
-qjZ cos{cx) -sin{a) 


-g/3 


For the sake of convenience, the subscripts are omitted from now. 
Considering the kinematics and dynamics of one leg. 

S = t - b ; L = IISIl; s = S/L 


= tan \SyfSx)] P = cos 0 = i}±P 

unit vectors c and d along the lower and upper links obtained from 

(i = (t-j)/u and -ip = tan~'^{dy/dx) 

sin[p) 

Angular velocities of the lower and upper links are given by 


where 


- A-l 


t 


-lsin{$) —usin{<l)) 


[ lcos{6) uco${^) J 

and the linear velocity of the intennediate joint is 
j = ic±e 

After carrying out the accelerations analysis, the angular accelerations of the two links 
are given by 


; =ArHt+vo) 


and the final expressions for the accelerations of the centres of gravity for the respective 
lower and upper links are given by 

-.OIWAL yWM’ 


i31IM 
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where and r„ denote the vector from the base point to the eg (centre of gravity) of the 
lower link and that from the intermediate joint to the eg of the upper links, respectively, 
and 


Vo = le^c + 


I sin(^- 9 ) 


V — - i2 _ 




o’" Vo 


usin{<j>'-B) 


2.4 Dynamics of the Manipulator 

Now, coming to the dynamic analysis of the leg, we first consider the moment equilibrium 
of the upper link about the point j and thereafter we take into account the moment equilib- 
rium of both the links as a whole about base point b (Since the manipulator works in the 
horizontal plane, the gravity effects are zero). This gives rise to two equations, namely 

ud^-p = 

and 

— -mu{lc + - mdr^±B.d - Idfi - lu^ + r 

where F denotes the reaction force exerted by the leg at output point and r gives the input 
torque. 

These two equations can be solved together for F and we get 


where 



1 

lsin{(^ — 6) 


rd — Qt -f U 


( 3 ) 
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Q = [muZ(dd^w - cr^j_)cxd^ - dc]^r«xc^ + zirriurl + /«)cc^ + ^ruixl + /d)dd^ 

V = mJ(udcI)V« + TTMudvl^Ya - 

TT - Cg-V 

lu$in{<t>~-B) 

G = m„Z(tidCj^) + mdwdrjj_ 

After getting the force components (both x and y) at the platform connection points, 
the dynamic equations of the platform can be written as 


-^ 1 ® + + ^Zx — 

Fly F2y Fzy = TUpyp 
ri X Fi + r2 X F2 + r3 X Fs = Ipdi 


13 



By substituting the force components obtained from the Eqn. 3 we get the final equa- 
tions of motion by considering the force and moment balance of the output link and the 
closed-form equations are derived in the form 


MT + rj = Ht 


where 
M = 


V 


(St=l Q* + ^phx2) 

. (12=, ■■riQi) (El. rlQiBL. + /,) 

Eli(-Ui + QiALidp 

[EliC-r. X U. + +rfj.QiALiC^) 


H 



Llisin{4>i~6i) i2sm(^-52) t3«n(^s-6s) 


Ti Ta Tz 


A = 


■cos(a) sin(a) 
■sin{a) -cos (a) 


B = 


-sin(a) —cos(a) 
cos(a) —sin(a) 


= [-p/2 - 5 / 3 ] La = [?)/2 -q/z\ L3 = [o 2q/Z 
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Chapter 3 

Servo Controller Design 


3.1 Introduction 

Given the dynamic equations of motion of the 3-DOF manipulator, the purpose of the 
controller is to maintain the dynamic response of the manipulator in accordance with 
some prespecified perfomaance criteria. Although the control problem can be stated in 
such a simple manner, its solution is complicated by inertial forces, coupling reaction 
forces, and gravity loading (of course, the gravity effects are zero in this case, since the 
manipulator works in horizontal plane) on the links. This chapter aims to demonstrate the 
design of a proportional plus derivative (PD) controller. 

3.2 The Model and Specifications 

Since oscillations about the point and overshooting the point is not desired, the controller 
should be designed so that the system is slightly over-damped. Also the system should 
take less time for reaching the goal position. Therefore, the present system will be re- 
quired to meet the following specifications: 

1. Slightly over-damped with C=1.05 (chosen) 

2. Settling time < Isec 

The follovine eauations are used in designing 
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Response 



Figure 3.1: Transient Response 
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Roots in s-plane 



c(t) = 1 + 






2 ^/( 2 -r .91 


92 


{t>0) 


where 

9l = (C + 

and 

*2 = (C - VC^ - l)w» 

Thus, the response c(t) includes two decaying exponential terms. 

So from the above Fig. 3.1, with the settling time as 1 sec, the natural frequency of the 
second order system is obtained as 6.5 rad/sec. With this natural frequency the poles of 
the system are fixed at Si and .s' 2 . The poles obtained are S 2 = -8.9 and 5i= -4.5 and shown 
in Fig. 3.2. 

From the control analysis point of view, the movement of a manipulator is usually 
accomplished by the gross motion control in which the end-effector moves from an ini- 
tial position/orientation to the vicinity of the desired target position/orientation along a 
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Figure 3.3: Relationship between the Trajectory Generator and the Manipulator 

planned trajectory. Since we wish to cause the manipulator end-effector to follow pre- 
scribed positon trajectories, but the actuators are commanded in terms of torque, there 
should be some kind of control system to compute appropriate actuator commands which 
will realize this desired motion. Almost always these torques are computed by using feed- 
back from the joint sensors to compute the torque required. Fig. 3.2 shows the relationship 
between the trajectory generator and the manipulator. 


3.3 State Variable Analysis 

3.3.1 Linearization 

A non-linear system exhibit behavior which can be radically different for different inputs, 
making them difficult to control. This present section shows how to obtain the linearized 
model of the present non-linear model. This is accomplished by approximating the behav- 
ior of the present nonlinear system in a limited range of operation.This range of operation 
may be considered the operating point of the system being linearized. The final dynamic 
equation is 


MT -f T 7 = Hr 


( 1 ) 


where 

H is the force-torque transformation matrix of size 3x3 

77 is a matrix of size 3x1 having the centripetal and coriolis components 

M is the mass matrix of size 3x3 
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Now to find the state of the system, state variables should be taken. 


State of a dynamic system is tlie smallest set of variables (called state variables) such 
that the knowledge of these variables at t = to, together with the input for t > to, com- 
pletely determines the behavior of the system for any time t > to- State variables of a 
dynamic system are the smallest set of variables which determine the state of the dynamic 
system. All the state variables form the State vector. The state vector is taken as 



X = 


cv 

X 


y 

Oi 


X=f(X,T) 


X 

y 

a 


Lm-^Ht - T})\ 


SX = A6X -h B5t 


where 






'0 0 0 1 0 0 

0 0 0 0 1 0 

0 0 0 0 0 1 

.qi q2 qs q4 qs qs. 


( 2 ) 

( 3 ) 
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Qi, q 2 , Qsj q 4 , qs, qe are given in Appendix A. 


0 0 
0 0 
0 0 


0 

0 

0 


M-^H 


3.3.2 Control Design using Pole Placement 


The first step before controller design is to check whether the present system is control- 
lable. The concept of controllability involves the dependence of state variables of the 
system on the inputs. The system described by Eqn. 2 is controllable if it is possible to 
construct a control signal which, in finite time interval will transfer the system state from 
X(0) to X(t/). We check this by fonning the controllability matrix: 


C = 


B AB 



The system is completely controllable if and only if the rank of the composite matrix C is 
6 (no. of state variables). 

The schematic diagram of a full-feedback system is shown in Fig. 3.3.2 where R is 
the reference input. 



Now a technique called “pole placement” is used to obtain the desired output. Poles 
of a closed-loop system can be found from the characteristic equation: determinant of 
[sI-(A-B*K)] matrix. If desired poles can be placed into the system by designing right 
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control matrix (K), then the desired output can be obtained. So, desired poles are obtained 
first and then MATLAB function “place” is used to find the corresponding control matrix 
(K). The poles are placed based on upon the criteria for the controller like the settling 
time, damping factor, no oscillations. Then the poles are kept at 


A = 



*'21 *12 *'22 * 1.3 *23 


Sji and .s'ai are the two dominant poles of the i-th actuation. After fixing the poles the 
MATLAB function “place” is used for finding control matrix K. There can be many solu- 
tions for K, but MATLAB gives only one such solution. 


K = pZace(A,B, A) 


K is a 3 X 6 matrix,where position gains Kp is the first 3x3 matrix and velocity gains 
Ky is the second 3x3 matrix 


(Task space ) 
coord s 



e 


4 



-i 


Figure 3.5; Feedback control block diagram of the 3-DOF Manipulator 

The individual joint PD control is essentially a technique which attempts to control 
the manipulator by using local, decoupled PD’s at each joint. In absence of friction or 
gravity, position control can be achieved by letting 


r = KpE + K,E 
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where E is the tracking error by finding the difference between the desired input value 
(Reference R) and the actual output (Y). The signal r is now equal to the proportional 
gain (Kp) times the magnitude of error plus the derivative gain (Kt,) times the derivative 
of the error. Kp and K^, are positive definite matrices of size 3x3. 

The control system can then compute how much torque to send to the actuators as a 
function of the tracking error. 
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Chapter 4 

Simulation Results 


The dynamic fomulation for the 3-DOF planar parallel manipulator has been imple- 
mented in MATLAB routines for forward dynamics (simulation). The program developed 
in the present work for forward dynamic simulation uses the MATLAB routine “ode45” 
(which is based on the 4th and 5th order Runge-Kutta formulas with adaptive step-size) 
for solving the system of dififerential equations. The program is first verified by con- 
sidering the regulation problem and then verified by simulating the dynamics to track a 
trajectory. It is observed that the platform is successfully regulated in the desired pose 
and orientation within a small time interval of .35 sec. 


4.1 Regulation 

Example 1 


The kinematic and dynamic parameters are shown in Appendix B. In Fig. 4.1, the ini- 
tial conditions are assumed as 

tT 


Xo= [ 


0 0 .083 0 0 0 


The desired position and orientation and their derivatives are 

-\T 


Xw = 


.5 .5 .35 0 0 0 
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Lin. Vel. (cm/s) Position (cm) 


The position and velocity gains obtained are as follows: 


Kp = 10-^ 


.3942 .2091 -.9153 

.5112 .2472 -1.0435 
.4636 .2339 -1.0946 


K, = lO-’ 


-.2983 

-.3656 

-.3847 


-.1011 

-.1583 

-.1653 


-.3053 

-.3503 

-.3651 


X Y 



time (s) time (s) time (s) 



Figure 4.1: Regulation : Example 1 
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Example 2 


In Fig. 4.2, the initial conditions ai’e assumed as 

Xo=[o 0 .083 0 0 o]^. 
The desired position and orientation and their derivatives are 


Xd 


0 0 .35 0 0 0 


T 


The position and velocity gains obtained are as follows: 


Kp = 10-^ 


.1357 -.0021 
.3229 .3546 

.2815 -.1108 


-.6170 

-.7381 

-.8,736 


Example 3 


K„ = 10^ 


.2320 

-.5629 

.1437 


-.6252 -.2016 
-.3865 -.3604 
-.054 -.7715_ 


In Fig. 4.3, the initial conditions are assumed as 

Xo=[o 0 .083 0 0 o]^. 
The desired position and orientation and their derivatives are 

Xd=[-1 -1 .35 0 0 o]^ 
The position and velocity gains obtained are as follows: 



.1732 

-.4217 

.2173 

Kp = 10® 

.2819 

.9146 

-.1638 


-.7412 

.3165 

-.7693_ 


■-.6155 

-.3175 

-.2734“ 

= 10® 

-.5914 

-.1092 

-.699 


-.1317 

-.0145 

-.4763 
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Figure 4.3; Regulation : Example 3 
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4.2 Tracking 


Tracking is done by repeated regulation. Duration of simulation is 6.5 sec. Two examples 
of tracking are considei'ed, in example 1 end-effector traces a trajectory of 

X = ^2sin(t) 2cos{t) 0 2co.9{f) —2sin{t) 0 

and in example 2 along a straight line. 










Lin. Vel. (cm/s) Posmn (cm) 


X Y 




time (s) time (s) time (s) 

Figure 4.5: Tracking : Example 2 
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Chapter 5 

Hardware Implementation 


This chapter explains software and hardware implementation in the present work. Com- 
puters are used to program robots, and the programming is done off-line. That means the 
robot is not directly involved when programming takes place. By using off-line program- 
ming, the programmer has greater flexibility to carry out complex operations, and the time 
spent in programming is reduced. In addition the robot can remain in service while the 
programming takes place, thereby increasing its productivity. 


5.1 Mechanical Hardware Description 

The complete chain-assembly of one leg of the mechanical system is shown in Fig. 5.1. 

The mechanical system mainly consists of DC motor mounted on a stand. It is jointed 
to the link 1 with a pin. The link 1 in turn jointed to link 2 with another pin. This chain 
is now pinned to the end-effector. Previously, Kalva [2] has done open-loop control of 
the manipulator using the stepper motors. In the present work, control is done with DC 
motors. So, the stepper motors are replaced with DC motors. 


5.2 Control System 

A personal computer based control system has been developed for the prototype parallel 
manipulator. The block diagram of this is shown in Fig. 5.2. The system contains tiiree 
major components: a host computer, the motor driver boards, and the motors. Each board 
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controls one motor, so a total of three boards are used. The function of the DC controller 
is to supply the motor with appropriate torque signals, in order to implement motion in 
desired direction and upto desired angle. The torque is calculated based on the position 
and velocity errors that are obtained from the feedback of the system. The feedback from 
the DC motors is by the optical encoders. The error in positioning is decided by the 
precision of the encoder feedback. Encoder gives feedback for each .6 degrees increment 
of angle. So the error in positioning is within ±.6. The DC motor controller includes a 
series of electronic switches responsible for switching the voltage of the stator coils which 
constitute the stator phase. 


5.3 Pulse Width Modulation (PWM) for Direct Control 
of DC motors 

DC motors can be controlled with a variable resistor or a variable resistor connected to 
a transistor. Even though this works well, it generates heat and hence wastage of power. 
The simple pulse width modulation DC motor control eliminates these problems. It con- 
trols the motor speed by driving tlie motor with short pulses. These pulses vary in duration 
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Motorl Motor 2 Motor 3 

Figure 5.2: Block diagram of the control system 


to change the speed of the motor. The longer the pulse width the faster the motor turns, 
and vice versa. The requirements of the PWM are as follows: 


• The controller must provide two outputs which are modulated 

• It must be possible to vary the outputs between the extremes of the first output 
high, the second low and the first output low and the second high. These extremes 
represent full speed in each direction. 


5.4 Driver Circuit 

The driver circuit takes signals from PC and sends signals to run the motors. It 
consists of three boards: card 1 , card 2 and card 3. Each card drives single DC 
motor. Each card have 74LS244, L298 and LM324 chips. The chip 74LS244 is a 
20 pin chip. It takes the control word from the parallel port and sends the signals 
to the motor to rotate. Depending on the control word the motor moves in forward 
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or reverse directions. The DC motors used are the escap motors. The encoder of 
the motor is connected to the LM324 and the pin connections are shown in the Fig. 

5.3. The feedback can be obtained on port 379. Bits 4,5,6 gives feedback for motor 

1.2.3. The motor gets its signal through L298 special 16 pin chip. The connections 
for the card 2 and card 3 are shown in Fig. 5.4. 


5.5 Interface with PC 

Interfacing links permit the manipulator to communicate with its controller and 
other parts of work station. Parts that do not cause the manipulator to do this task 
directly ai'e called peripheral components. The microprocessor controlled manip- 
ulator can communicate with the equipment around it through connections called 
ports. For example, it is necessary for the manipulator to input information to the 
controller, and it must be able to receive information to the controller. Hence the 
controller is connected to the manipulator through a port. Parallel ports are the out- 
puts of the microprocessor or computer that have flat cables connected to them with 
eight conductors. This parallel port is connected to the input of the controller cir- 
cuit. The signals generated by the computer are fed to the controller circuit through 
the parallel port. For generating signals, Turbo C provide access to the I/O ports on 
the Pentium CPU via the predefined functions, inportb/inportand outportb/outport. 
For the present work, outportb and inportb are used which outputs and inputs a byte 
to the hardware port. This is the interface between program and DC motor control 
circuit. The usage of the outportb is as follows: 

include<stdio.h> 
include<dos.h> 
unsigned char bits; 

outponb(Ox378,bits); /*output bits through 0x278 port*/ 

In the above program, 0x378 is the printer port address. Writing to this address 
causes data to be stored in the printers data buffer. The feedback input is taken 
from the port address 0x379. 
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Figure 5.3: Driver circuit pin connections 
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Figure 5.4: Pin connections for card 2 and card 3 





In the control of 3-DOF parallel manipulator three DC motors are used for activat- 
ing the links. The controller circuit of each motor needs two bits, one for forward(f) 
and another for reverse directions(r). If both the bits are zeros or I’s then the motor 
will stop rotating. To control all the three motors 6 bits are required. The bit pattern 
for the all the three motors are shown below: 

In the present work, regulation problem is dealt. This involves the positioning of 









Unused 

Bits 


Motor 3 Motor 2 Motor 1 


Figure 5.5: Control word bit patterns for the three motors 


the end-efifector at the desired point. Later with repeated regulation, the end-effector 
is tracked along a trajectory specified. 


5.6 Software Description 

The software necessary for controlling the hardware is developed in TURBO C. 
The software mainly consists of taking the initial position and velocity of the end- 
effector in joint space co-ordinates from a data file. This data file consists of initial 
position (joint space), orientation of the platfonn,velocity of the end-effector, de- 
sired position and velocity of the end-effector, position and velocity gains. The 
torque required is calculated based on the difference between the tracking error and 
error derivative. This is calculated for all the motors and accordingly each motor 
is activated by creating a control word. Flow chart for coordinated control of the 
manipulator is shown in Fig.5.6 





Figure 5.6: Control flow-chart 
















Chapter 6 


Experimental Results 


6.1 Testing of Performance 

The main idea is to test the practical prototype to move from one postion and orien- 
tation (’x’ and ’y’ coordinates in cm and angle in degrees) to desired position and 
orientation. The test data is given in the Table. 6.1. 


Initial Pos. and Orien. 

Final Pos. and Orien. 

0 0 0 

0 0 40 

0 0 0 

2 2 15 

0 0 0 

-2 2 0 

0 0 0 

-2 -2 -10 

-2 -2 0 

2 2 30 

2-2 0 

-2 2 0 

-2 2 0 

-2 -2 -15 

-2 -2 0 

2 -2 20 


Table 6.1 : Experimental Test Data 





6.1.1 Accuracy 


TTie precision with which a computed point can be attained is called the accuracy 
of the manipulator. The practical prototype is successfully able to move from initial 
configuration to the final configuration with an accuracy upto ±2.0mm along X- 
axis and ±3.0mm along Y-axis and ±4° orientation. Therefore, the end-efifector 
reaches a final point which is within a radius ’R’ about the desired point. 

R = yjAXj + AY^ = \/22 -H 32 = 3.61mm 
Accuracy is affected by the precision of parameters appearing in the kinematic 




Figure 6.1: Enor bounds in Positioning and Orientation 

equations. Errors in Denavit-Hartenberg parameters will cause the inverse kine- 
matic equations to calculate joint angle values which are in error. In addition, errors 
in estimation of dynamic parameters introduce further loss of accuracy. Calibration 
techniques can be devised which allow the accuracy of the manipulator to be im- 
proved through estimation of kinematic and dynamic parameters. 

6.1.2 Repeatability 

Repeatability is a measure of how precisely a manipulator can return to the desired 
configuration. The repeatability of the practical prototype is quite good. It is re- 
peatable within an error bound of ±lmm along X-axis and ±lmm along Y-axis 
and ±2° in orientation. 


Chapter 7 
Conclusions 


7.1 Summary 

Closed-form dynamic equations have been derived for the 3-DOF planar parallel 
manipulator using Newton-Euler approach. A PD controller is designed for po- 
sitioning and orienting the manipulator. Simulation results of forward dynamics 
are presented for both regulation and tracking problem. Experimental results for 
regulation are reported which are in accordance with the simulation results. 


7.2 Suggestions for Future Work 

- Tracking control can be done for precisely tracing the trajectory. 

- More robust non-linear control laws can be applied to control the manipulator 
in entire workspace. 

- Calibration needs to be done on this prototype manipulator to reduce the error 
in positioning. 

- By using DC motors of higher gear reduction ratio, we can position the end- 
effector more precisely. 



Appendix A 

Intermediate Terms in the 
Dynamic Analysis 


Detailed expressions of various terms used in the thesis. 

qi = -MM{1 :2,1 ; - MM(1 ; 2,3)^^ 

q2 = -MM {I ; 2,1 : 2)^^^^^^ - MM(1 : 2,3)^^ 

oy oy 

qs = -MM(1 : 2,1 : 2) *^^^] — ^ - MM{1 : 2,3)^^ 

006 OCX 

q4 = -MM(1 : 2, 1 ; 2)^^?^^ - MM(1 : 2,3)^^ 
qs = -MM{\ : 2,1 : _ mM(1 : 2,3)^^ 

qe = -MM(1 : 2, 1 : 2) - MM{1 : 2, 3)^^ 



where 
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-cos (a) 
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Appendix B 

Kinematic and Dynamic 
Parameters and Motor 
Specifications 


B.l Kinematic and Dynamic parameters 


Base coordinates = 


-11.3 

-12 


11.2 - 1.6 
-9.9 11 


Link lenghts: 

Length of the upper link ’u’ : 9.5 cm 

Length of the lower link ’1’: 12.75 cm 

Length of each side of the platform ’p’: 5 cm 


Mass of the links: 

Mass of the upper link ’m^’: .03 kg 

Mass of the lower link ’md’: .025 kg 

Mass of the platform 'itip': .03 kg 

Moment of inertias of the links: 

Moment of inertia of the upper link 1 .6256 kgcm^ 
Moment of Inertia of the lower link ’ Id ‘ 0.752 kgam?' 



Moment of Inertia of the platform ’/p’: 2.3 kgcm^ 


B.2 Motor Specifications 

Stall Torque 720 kgmw? 

Max. speed 9000 rpm 

Rotor Moment of Inertia .07 14 kgcm^ 



m ‘ 
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